#!/usr/bin/env python
import roslib; roslib.load_manifest('smc_04b')
import rospy
from std_msgs.msg import String
def commander():
	pub = rospy.Publisher('commands', String)
	rospy.init_node('commander')
	while not rospy.is_shutdown():
		motor_command = [0x80, 0x00, 0x01, 0x00]
		motor_command_header = rospy.get_time()
		for cmd in motor_command:		
			rospy.loginfo(cmd)
			pub.publish(str(cmd))		
		rospy.loginfo(motor_command_header)
		
		rospy.sleep(1.0)
if __name__ == '__main__':
	try:
		commander()
	except rospy.ROSInterruptException: pass
